g++ -I/usr/include/eigen3 ekf.cpp -o ekf
./ekf
python3 plot.py